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(54)Title: DEVICE AND METHOD FOR CONTROLLING JOINT MECHANISM, JOINT DEVICE, ROBOT DEVICE, AND 
METHOD FOR CONTROLLING ROBOT DEVICE 



(57) Abstract 

A device and method for controlling a joint mechanism, a 
robot device and a method for controlling the robot device, 
comprising current sensing means for measuring the current value of 
a drive current fed to an actuator of the joint mechanism and external 
force torque sensing means for measuring the magnitude of a torque 
by an external force applied to the output shaft of the actuator on the 
basis of the measured current value. A joint device and a robot 
device comprising a motor unit for generating a torque in the 
actuator and motor control means for driving/controlling the motor 
unit. The motor control means is disposed in the motor unit. 
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2©^||fig 

ci:iTi5^'yrv^^D=i>i^ji.-^ 1 1 5{±. 01 9^z^^■rct^t3. mn^ 

S:/n^y^l2 8. Ixi^^^l2 9s P-^$l!llE]|E^mi^mM^D ^ 1 3 0 

^ - 3mmmn^^m^myu ^ 1 3 1^ mmMmmM-yx^-j^ 132 
Rxj^mi--m4(D-r-^ti ^-y^'-i ^ jv^m^^ 1 33-13 6i>^mm^nx 

^bT:iCDl^^^rx'^^Di3>t:^-^4 5T'(is ^N-y-Ml 1 2*-e)# 

x.?)n^i§ 1 3 ®iEibm»^+^mM-^ s 3 a~s 3 c^^ 1 cDr:^D^/5=^-Y 
1 3 3 ^3*5^^T^n^n7^'f i^^;!/^?^^. 1 3 

©mi&Si^t^mT-'— ^ D 3 D 3 B ^«»i|jqM:/D >^ ^ 1 3 2 Iz-^^ :t> t 

mz, ^ti^mi'--m3(Dmmmm^my'-'^D 3 A. T>3B^]yiy7.^ 1 2 9 
izi^m-r^o 

^fc l^^yy-^^ ^uu>\^a. — ^ 1 1 5Ttts 1 ilI^$g^^JS-fe>-9- 1 0 9 

(1119. EI 1 3 (o) tf^ibm:^-^n^m\Rxjm2(Dimm,mnn^'t>^m^ 

S 1 A. SI B^^3(DTi-U ^/v" ^ v^;i/^mifi]SS 1 3 5{343V^T7=^^ 

f#^n;tiiisr>'^2©iiii^^^^^j^-fe>it7=^-^5'D 1 A. dib 

^l^ -^^^ 1 2 9 {3|SM-r -g>o 
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18 A. 118B (^17) >?P^#;t ^n-5D — ^llUM^J^-tr 1 1 OcDtH 

Rv^m 2(Dv-'^$mmMm-^ >V'^-^ d 2 a. d 2 B^n-^mm^Mm^^ 
mmmyvy^ 1 3 oizxti-r^^ 

^mmmMm±>v-y'-'^'D 2 a. d 2 Bt3So*v>TD-^$ft2 4(Dmmm^M 

& h;i/^- 3*i«::^{t^'gj^Ms:7*D 1 3 1 {zji^m-rso 

m9 4(DMmzm^mi'-m4(D^^-jm^i 1 4a~i 1 4D{cj:Dti^m^n 
5t^flix'^;?^^3/ h 1 1 3(Dmm-r?>-Mo)NmRxfsmi>z^:^mmmt^imm 

(0~2;r) ^-r^^J^^lA^o ^LT^©^Jg©ff$^{zi5VNT(iMJ3iv^^. -/ 
h 1 1 3t^4mizmM^tiX\,>^tzib. ^ — ^^mm^mM^Pmli^O-fy^^ 4 

fe^ ist5ii2© 1 mu^M'^m.-t>v-7'—^i) 1 A^ D 1 B^mz'D—^mm. 
hjv^ti^^) T 0 ^mmv. mn^^^^ui^x^ 1 2 9{z;iSi^-r^o ^^scicd 

^ h;i/^*s-^x.^n^ 1 ems') ^rtizWiii^ti^o 

^bTcicDg^g h;i/^TO (i, h;i/^-3 4Bm«^M-^^mMll::^D^y^ 1 3 1 
iz^fom^ki^i^X^ 1 2 9;?p?>a^J^m^n§o ^bT 3*g«^«-^^^ 
M:^D ^ 1 3 1 {i. ^cD^mhJl^ TO D — ^lftIil^^jg:^mM>^D 

1 3 ^nsD— ^$16 9 4(DmmMme p tizm-:5\,>x. ^— ^gp 
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9 0{3*5{t5Uffi. vm. W^a®=S-=3-i';i/9 9 A~9 9 Flz-en^tiEPip-r^^ 

mmMwm^y'n >y ^ i 3 2 h)v^- smmMM^^i^mmyti ^ 13 

3 A~D 3 C^t3^-:5l>Tx ^ 1 ~^ 3 om^Ji^MU r . Vr. WrlzMl^X 

Pulse Width M o d u 1 a t i o n ) ^Sl bs Ji ^ tl^^ 1 ~^ 3 
CDPWMM-^S 4 A~S 4 C^m3(D^ — yjV 1 2 1 bT ^ n^/iy— 

1 1 2©n-r ;nii/j:^n y ^ 1 2 1 {3jiiaj-r2>o 

^:fe^3(D>r — 12 1 ^ 1 '-^3®PWMM-^S 4 A~S 4 CfflC3 

^tl^n2:$:c7)-7^ >>{)^'|g^t^tlTl^^o ^ UTm^MWMS^P ^ 1 3 2 

^ m;d$iiiio6 (1119) ^jEmmm-r^t^izi±mi-m3(DPWMm^s 4 A 
~s 4 c >^ -en-en— ^cDH i >^iff\yX^^u—mR i i 2cD=3-r ;L/|gtb 

rny^ 1 2 2 fciim-r^ m 3©PWMM-^S 4 A~S 4 Cf345 

{t^aroiiroj u^)V(Dm-^ (my. ^nib^mi-m3(Dmmim'^t^-^) s 
5 A~s 5 c^m:^(D^m2(D^ ^ y^^n^ni\-\yxnu--mRi i 2o=i-r 

^tzmm.Mmmmyn ^ i 3 2 a. 1 0 e ^j^^Mt-s^^tca^ 

l~^3 0PWMM-^S 4 A~S 4 C^^tl^tim 2 (D^ >&/rbT/W— S 
IKl 1 2 0=i^;Hgitj:/p 1 2 2{3j^mi-Shit{c. ^ 1 3 
S 5 A~S 5 C^^n^tl^m l(D^-( >^lf^lyX^^U-mEL 1 1 2(DZJ4;vm 
fij^D 1 2 2(Zj^m-r^o 

— ;5n>r;i/iEi&^p 1 2 2{3;fcl^T^is El 1 8 u^a^ 

.J\imm.^Xl^-J\^-^9-9-A^9-9^E-lZ-^U^ 

138A~138C3!p^^^ InHt^l^doCD^ 1 3 ® h K nUSS 13 9 
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©NPN^ h^>i;>^^TR3. TR4ti-(brj:^mmmm(Dmi--m3(D^ 
-^Hl^l 4 OA- 1 4 0 CT^fiJc^tLTl^So 

^ >t^^ti^tiMJiB'r^m 1 -^mScD^- h :/|alSg 1 3 9 A~ 1 3 9 CCD 

miRxfm3(Dmmmi 3 sa. i 3 8 c^^n^Hin-hmmT 1 --m 3 

(D^ >/^-^m^ 1 4 OA- 14 0 C(7DM2<DPNPM h^>s;:;^^TR 2©^ 

-^R-o^mi(DNFNmh^>i^x^TR3(D-<-xtmm^ti. urns vmR 

4 OA- 1 4 0 C0^2^5:t>*^4®tii|@^l 3 8 B. 13 8 D^^ti^n/rbT 
^^tv-r^ll 1 — ^ 3 ®^ >y^ — 140A-140 C©^2(DPNPM h ^ 
>i>:^^ T R 2 >;;S:t>*^ 1 P NM h ^ >i;^X^5' T R 4 

ni';i/9 9 A~9 9 F*s^tl^n^JJ&-rsm l-^3 0'f >7^"-^(i]^^ 1 4 OA 
-14 0 CtCiJttS^ 1 £DPNP^ h^>i^:;^^TR 1 com ly^ RUm 1 (DN 
PNmh^>i^:y(.^TR3<Dzily^^(Dmm^}^t. ^20PNPMh^>i^X 
^ T R 2 ©n b ^ ^iJ:t>'^ 2 CD N P h ^ >S^;^ ^ T R 4 ©n 1/ ^ ^CD^i^cja 

"^mmiz, miKitm2<D^-f ><fe^bT#x.6n^^ i-^3©pwMfH-^s 
4 A— s 4 c^^n^tiMiiBT^m 1— ^so-r >yN-— ^mi^i 4 0 a— 140 

n^ii&Tsu^B. v^B:&tFw^a©^r]>r ;i'9 9 a- 9 9 Fjzgijfjnf sciiiJb^Tt 

9 A-9 9 F{3#fc^-rSigltja^I u. Iv. I w©:;*;^^^^ 1~^3©^ > 
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m^mm-^s 3 A~s 3c t hrmm^m 1 1 lo 1 r-^^ ^D=I>l^i- 
y i i 5 as 1 (DTTn c^y^^ i^'^ji^mmm 133 (ei 1 9 ) {z?iim-r5 j; 

-S o 

m^M:7'D 'y^>128(i. CPU (Central Processing 
Unit) 1 4 8 Mrn^'^A:^p'*&|irt^tifcROM (Re ad Only 
Memory) 14 9^. C P U 1 4 8 CDy — ^ ^ i; ^ l^-^^R AM ( 
Random Access Memory) 1 5 0 MJie^-T ^"^-^MMB 7 

3 A~7 3D t(Dm<DXtiiti-( > ^ y :^—^^mx'^ V T)vmmmxiii±im 

^15 2t. -tf— :1^fim^CDfe(»(D 1 Cms) M«9CD1t— ^fUM-^S 1 OStf 

pwummx'^^ 5 0 C//m: ji«g®pwM^NVi/;^fg^s i i s^^-r^i?--^ 
fjiiM^^^iiigg 1 5 3h. ^-^^mj^m^m'^mmi 5 3iy^io^-mmm^ 

S 1 0*siEi^<^^^^-^,^,;g,^^CPU 1 4 8 3tjS|^m-r2.fc«)C!) 1 Cms: M 

M-^^^ms&i 5 4 i:*^'cpuM';;^ i 5 5 ^irtvxmis.izmm^ti^z. tizx ^ 

cicD^^cpu 1 4 8(d:. Mm-r^v-rmm^i 3 a-? sD^^^sjeenfflaH 
(5 cv:) t^-^^i^ti^h. ^-TROM 1 4 9 iz^m^nrcwmyti 2:.iz^ 
■^i^x ^) T )i/mmmxtii±fm^ 1 52s *'^7>^5'-^>rv.i3> hn— ;i/|piies 

15 3s P — ^$AliI^^J^tiimM^:^D »y ^ 1 3 Os h;i/^ - 3 ffim^ft^^J^ 

>y ^ 1 3 1 s mmmmmmyxj 13 2miz^T ^mmmm^^'i^ 

_^fe-C_P JJJ_4_8Jis_:i_©JS^.^-U-C^:*?-»t7->^--^ • 3^ f -0 — l- - 

5 3^^-^x.?)n§-t^--7}^iimfs^s 1 ozit>*ROM 1 4 9 izmm^titzMm-t 
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mm^^i Cms:} mmrm^wmizmnt^o 

(2-3) Vy h'^:cTM 

V . =j> hD-;Hp]g&l 5 3*^^#;^?,n?,-9— ^'iijjia^s 1 0;St>'RO 
Ml 4 9{C^SiM^n;t^i;&-rsrD^^A{z^o'v>T> 1 CmsD MSBX-B^^ty 

(2 - 3 - 1 ) ^-^J^dl^^JIWil^M^- KBttziJltSCPU 1 4 8 
^ — KB${zi5{ti.CPU 1 4 ScDMMtis ±5zli® ct-5 

A~ 7 3 D}?p6t§^|pl^{4gp r e f ifi-^^i^n^m^lzi^,. 

^Ihmmyu >y ^ i 3 0{;:J: D i^^^;^^ 1 2 9 ic^i^^ns D-^lfij^^ldl^^ 

spm 1 ^zs^v^TtH;bfS9 4 m9) (DmmitmFm^nmT^tmz, ^© 

Vmre/ = (Pre/ - P/n) x ( i ) 

V>w = Pm xS ( 2 ) 

^^n^timn-r^^Ltizxf^. m^m^^sfip r e f {z^-rsB^gcDiu^iijg 

T?#5)n:t ( 1) ^JSlV^ (2) ^yjp^i^c^ 
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|[V/wre/-V>n]x l + 



X Kvp 



(3) 



7 SBti^^m^m^ h;i/^ Tref ^ ti?>tl-^{c{i. z.n^^€D^^m^m 

^CiJCin^ (1) - (4) 5^{Z43V^Ts S{i-7r^;;^^^^:Sr^b. Kpp. 

^^^{c J: Ji^ln]fe:^JSPref ^m^m^MV r e f tc^-T ?>^-^ M- 1 

CPU 1 4 8(i. V'Z^mm^7 3 A-? 3D>?P^Jg^Il]^^JKP r efi^-^^ 
-^DIA. D 1 B^3«-:3v^TD-^$^$tf^9 4®i^^|s]$sl^ (JilTs ^--^mmm 

JSi2_i^tLl_l_0_O.||.l^||-4-CD.5lK=-;b-^ ^-1 -1^ 

^flif-x'^;?^';' h 1 1 3<DmmT^~n(DNmRxj^smizx^mMmt^immt 




(4) 
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D^mb (X^^;/rS P 1 A)s ^O^u*g0 gi;: 3 ©3SM=¥ 

6®:^Tl:tN^^^b (:^7->yrs P IB). :i(Dmmmm^ 2 TcX'Wi 

^Wi.x^(Dwmmm(Dmm^'^izn-'^mmmnm-^>vi i o md) (om 
^fecpui4 8{i. m2 Q\.z7Ts-r^o\z^ z.<D^oiz\^xm-m\^fzu—^m 

m 1 iitw^-^^, 

PmO '=2jtxNm ( 5 ) 

x-¥^^ti^Pmommmh\.x. 

Pm = PmO+Pml ( 6 ) 

(>^7^^vrsp 2)o 

^ UrCPU 1 4 SJis Ji^dlfe^JgP r e f :?p?,clCD|Hl^^J^Pm<^MW-r 
S<r<Ji(zJ:D. Jii^lBlS^J^P r e f {z^1-?>|^^ (i^j^Ts dtt^lUfe^Jg^^ 
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mi^w^-r^^tiz^y)^(Dh^cDiiiijmi 0 ecDm^mrnvm^ntii-r^ ( 

;:^7^-y :^ S P;5 ) t 

Vmr e f A^^XT^^yrSP 5 {^ifev^TlEm UfelD^jiJgVin^M^-r C 
^^V^TCPU 1 4 8{±^ CI ©jiiJgMM V e (3^^^ 

+ 

s 

P 7 2it>'X7^^y rs P 8)o ^ntCct «3 B^IU^ h;i'^ T O^m^^tt^X'^^o 
^45CPU14 8{i. ^-^m^^J^M^Ma^- K^. ifr^ij^gp? 3 A~ 
7 SD-fy^i^m^m^m^y r e fi^^^^flX\^^^t^iZl±:L(Dmm^Xy^^yy' 
SP 6f3*^^|^$^b. ll]feh;i/^Tr e f ^{p'^x. ^nTV>-2» h ^{3{icn^^® 
S^glf h;!/^' TO ^UTl/i^:^^57 1 2 9{c^&iirt-r5o 
( 2 - 3 - 2 ) S> U K^{:::fc{t S C P U 1 4 8 comM 

^feCPU14 8{i. i/UT;i/JiMmS^- it:/^Ji;?aP 7 3 A~ 7 3 D 
i:MM<&^fl^s ^^mm^l 3 A~7 3DA^^(DM3^> K-^^S/'^^^-^ 
^A:;^?b^ Sfe(i^-^fflCl*lgPM^S-9-r$iJfpgP7 3 A~7 3DtCji^m-r^o 
(2-4) =i-r;HgiijSMi:m;b h;i/^®M{^ 
^LZ.XCKD^olzm-m^tirc'E — '^M- 1~M- 1 4{34bntS^-^^9 OCD 
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^-rvm. v*g:st>'w^i®^=j-r;i/9 9 A~9 9 F(3igi&«^i u. iv. i 

w^ML;fe^§{zj3{t^^n?)U^. vmRXf^/^m(D^^ ^ JV 9 9 A~9 9 F 
T(ep} = lux^xKO + IvxipvxKO + Iwx^wxKO (8) 



<^ cfcotC-^;^ e>n^o tj:^CL(D (8) ^IZ^l^X. K 0{i#u^;i/9 9 A~9 
dClT-U^g, V^IBZ^UfW^gO^S-u-r ;i/ 9 9 A~9 9 F tcEP^jp-T SHibS^ I u 



/m = /Ox sin ^ 



/v = /O X sin 



/w = 70 X sin 



2;r 



(9) 

(1 0) 

(1 1) 



2jt 



^ = 00 X sin ^ 



^ = 00 X sin 



2^ 



(12) 



(13) 
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4>w = </>0x sin 



271 ' 



(14) 



'^■^rmtihjv^T (Op) {±. o) (i4) (s) ^tzftx 



nop) 

^I0x<pOx ^0{sin^ X sin<^ 



+ sin 


ep + 


2n- 
3 


X sin 




2jt' 
3 


+ sin 


0p- 


In' 
3 


X sin 


ep- 


27t' 



"lOxipOxKl (fBb K1 = 15K0) (15) 

t^oT^®^ — ^M - 1~M- 1 4-^{i. ^n>r;i/9 9 A~9 9 F{cEp;!jpf S 

o 

(3) ^^m^^TffeWM 

ti'iS^^mWLl^'bWXXC^CDU^s^y h 1 0 ^g-j^aso-- .7 h 1 4 As 1 4 B 

— ^M- 13. M- 1 4:^um-r^^mmm7um^m^no^^\zti::^nx\^ 

S o 

^•ii-^) J;o{3s ^-ifB|gS^#l4 3g)^^— ^M - 13s M - 1 ^^_ig.^.^.MM. 
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ro J ^^Sct^(c=&^-^M- 13. M - 1 4(Dmm^mmr^^tizj:on 

f^B#s p< ^ >^J|3?gP 7 0 (EI?) *^^^l©B$F^P^PiT'=g-^-^M-9~M- 1 
^M- 13. M- 1 4(301>TEI2 2 fC^f^M^firMa^MR T 1 tztt^oT 

7 0^^^Mlltl^^4 3(D^^—^M- 13s M- 1 4 ® h-T-^^IUlK;^ 
^A^^-^;?.^ti?.h30^Miife^fTM^JIiRT 1 ^X^^^j^rSP 1 Otz^jiNTl^ 
$&b> ^<X5^^^rSP 1 1 {3*5V>T5fcfTbTy ^ >atJ|®gP7 0>{p^-^;t ^tLTt 
S-ifM®^«4 3®=g-^-^M- 1 3. M- 1 4(Dmmt-r^^\B\mM^t. ^ 
^^-f >mM^7 0*^e>^x.^n;fez:ti6^— ^M- 13. M- 1 4(D^mt'r 
■-^§llIte^Jgi:^6^^-^M- 1 3. M- 1 4(7)^J|fM^T'$>-5 1 Cm s D 

fco^^-^M- 13. M- 1 4(Dm^\n\mmm. m^m^mmRi±m^mm h 
;i/ ^ ^ ^ n m -r s o 

>5^M- 1 3. M- 1 4*sS^i:-r-<tlHlfe^Jgds^^^ns©^{z{±. 1 CmsD 

cTiicD^s-^-^M- 1 3. M- 1 4®ji^[Hife^jg. m^mmmm.^itm^mm 
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3©i:^-b-:/$iJM7 3D{3{i. SlfUgS^a 4 3 M- 1 3 . M- 
mRl 12 (0 18) ©=&n-r;Hg»j:^D 140A~140C (EI 18) (D 

s^^2>■9-7 1 (mi 8> ifiit>^n^fimij^titzmi--ms(Dmmmm.^mm 

■^S3A~S3C (EI18) ^ l^^'^r^-f ^P3>b*i — ^ 115 (HI 1 9 ) 
(Dmi(DTi-ti^X^^ iy^JV^mm^l 3 3 (EIIS) {3*5V^T^V 

m-r^^tiz^^)m^nrzmi--m3(D%mmm.^iiiy'-'^B 3 a~d 3c m 

1 9 ) *^^X.^tLSo 

}?P< LT-y-^M^7 3D{i. CCD^l-mSCDMl&S^t^ttlT^-'-^D 3 A~ 
D3C^:^7^\vrSPl 4{3j3V^T^^ — ^$7M- 13. M - 1 4ifi^m^^n^ 
^l~^3©iEaijm«^ttm^"-^D 3 A~D 3 C^mDji^^. i^<;^5^'yrSP 

1 5 Iz^i^^X^com 1 ~^3®IKt&«m:^m7^— 3 A~D 3 C{3a-c5V>TS 
■ifM«<t4 3©=S-^ — ^M - 13. M - 1 4<D^(Dt^(Dliiti VJ\y^Tm^m- 

m-r2)o 

^ ^izv:^mm^7 3D{±. y^^^^rsp i 6^3ii^-r-cl(7)m±^h;^^Tm*^ 

5) ^468311 bTV^^-^(D^;^-—AI^#^3ga^Z.i: — ^M - 13. M - 1 4 CD 

M-13. M- 1 4©m;b$fi 1 0 6 ic^Cfe (JilT. cin^^;bh;i/^T 

^ t^izvymm^i 3Dii. ci©^;:^7^^3/rs p 1 7 ^z^i^T^®^mbfe^ 
tih)i^ Tf(Dmt^ ro J T'fe^>?pg*^^^^-^M- 13. M - 1 4mizmm 

CdT-dCDX^^J^rSP 1 7tC4b^^T#^^^^^f Sei^ti. ^Jx.{i*SgP4 4 
TV^^Ch^^n^b. CL(Dt^V-ymm^7 4T>l±:7.y'^yy'SF 1 2izm^. C 
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3. M- 1 4CDmijm 10 8 iz-^x. ^fi^%± T f (Dmt^ ro J (zje-^x 
:r:h\z:;^7^-j-rsv 2\>An^nm\zmM'r^o 

:l(D^o\z\^x:i(Du^.^^ h i o-e(i. ^mUo.-^y h 1 4 A. 1 4B®-y-:/ 

fgjjM? '^Di^'Z^mzmxyx^mmmmmA 3(d=e--^m- i a. m- i a\.z^ 

Mifei3*?v^T ^ M'-^ >:;^ h 5& < iE U < -r ^ ^ i; ^ -5 J: d (3 75:^ 

(4) :^mm(D^m(Dmi'^^m)}m 

4 A. 1 4 B®^lrlBfiPM^4 3 CD#^— ^M- 1 3s M- 1 4 CDm±?l£& 1 0 6 
t3#^e>n^^ij h;i/^T f roj J;ajzcin?)^-^M- 1 3. 

M- 1 4®lp||e^»t-So 

t^e-3Ts :L<Dti^.^y Y 1 ox\±^ ^n^Mt^m^'^mei^m-r^^m'mx^ 

^fed^DpJf-; h 1 0-e{i> — ^M - 1~M- 1 4®|^^{z^— ^gP9 0 
^IKi&M^^fetooaiJ^^^fi 1 1 lSt>VW— a^Rl 1 2;{)SiRiW^nTV^Sfe 
«). l2l8©J:^{c=&1t:r$!l|^gP7 3 A~7 3 D {3^ bT^tf 7 2^(D>7--:/;i/^/h 
bT^T®^-^M- 1 ~M- 1 4 ^gE^-r^Cl^^*T'§. ^CD^D5}<'y 

i: \^x<Dmmm.^i&m'r^:Lhtfx^^o 
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:^ ^lZZ.(Dn:^.^y h 1 OT{is =S-^ — ^M- 1 —M- 1 4 t bT^— ^gP9 0 

x^mmmm mmmmm2 2. ^mmmm2 iHiggi5M^2 9. mmm^m 
3 2. asMM^a 6. mm^wmA i^xi^-mmmmmA 3) o^fijo^sma^b 

g|5^--;hl4A. 1 4 BcDSmi9gS^m4 3©#^— ^M- 1 3s M-14® 
ttJ;^$lll 1 0 6{z-^^ ^ns^;^; h;i/^ T roj ^;&:z> J: a fcdti^ 

^M-13. M- 1 4®Il]fe<£M-rs J;^{3b:^ci^{iJ; t)s ^frSSSyb^'MM 

"pm^h^m-r ^^mmMx-^ -^f^m^iz^x^^x ^•miz'M'^\^xm=7-r ^ z. ht^x 

*fcD;}^>^hlO {3451>T> =§-^ — ^M - 1 ~M- 1 4<Df^^t,Z^ — i^^9 0 

( 5 ) moDmmcDmm 

T^^oizi^tzm-^iz-Di^^xj^-^tct^. :^mm±^tnzwi^-r. zcD^m^cou 
^^^i^hizfK<mm-r^ciht^x^^o z(Dm^i<z:^\.^x. ^m^mcDo-^comw 
^m(DmmizmT ^^miz^i^^xi:^. 4s^ff^p^"^^ v'^^niii^cDm^^n 
ma-r^^y hizii}i:<mmT^ztifx^^o ^rz:^mMm(Do-ib(D^mwum(D 
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applicant to furnish a copy of the international application (Rule 49.1 (a-bis)). 

3. Enclosed with this Notice is a copy of the international application as published by the International Bureau on 
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REMINDER REGARDING CHAPTER II (Article 31(2)(a) and Rule 54.2) 

If the applicant wishes to postpone entry into the national phase until 30 months (or later in some Offices) from the priority 
date, a demand for international preliminary examination must be filed with the competent International Preliminary 
Examining Authority before the expiration of 19 months from the priority date. 

It is the applicant's sole responsibility to monitor the 1 9-month time limit. 

Note that only an applicant who is a national or resident of a PCT Contracting State which is bound by Chapter II has the 
right to file a demand for international preliminary examination. 



REMINDER REGARDING ENTRY INTO THE NATIONAL PHASE (Article 22 or 39(1)) 

If the applicant wishes to proceed with the international application in the national phase, he must, within 20 months 
or 30 months, or later in some Offices, perform the acts referred to therein before each designated or elected Office. 

For further important information on the time limits and acts to be performed for entering the national phase, see the 
Annex to Form PCT/IB/301 (Notification of Receipt of Record Copy) and Volume II of the PCT Applicant's Guide. 
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TANA8E PATENT OFFICeI 



Date of mailing (day/month/year) 
01 March 2000(01.03.00) 


IMPORTANT NOTIFICATION 


Applicant's or agent's file reference 

S00P0158WO00 


International application No. 
PCT/J POO/007 54 



25 February 2000 (25.02.00) 



The applicant is hereby notified that the International Bureau has received the record copy of the international application as 
detailed below. 

Name(s) of the applicant(s) and State(s) for which they are applicants: 

SONY CORPORATION (for all designated States except US) 
ISHIDA/Tatsuzou et al (for US) 

International filing date : 10 February 2000 (10.02.00) 

Priority date{s) claimed : 10 February 1999 (10.02.99) 

08 SeptembeM 999 {08.09.90) 

Date of receipt of the record copy 
by the International Bureau : 

List of designated Offices : 

EP :DE,FR,GB 
National :US 



ATTENTION 

The applicant should carefully check the data appearing in this Notification. In case of any discrepancy between these data 
and the indications. in the international application, the applicant should immediately inform the International Bureau. 

In addition, the applicant's attention is drawn to the information contained in the Annex, relating to: 



time limits for entry into the national phase 
[ X [ confirmation of precautionary designations 
I I requirements regarding priority documents 
A copy of this Notification is being sent to the receiving Office and to the International Searching Authority. 
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FORM PCT/IB/301 



iternational application No. 

PCT/J POO/00754 



INFORMATION ON TIME LIMITS FOR ENTERING THE NATIONAL PHASE 



The applicant is reminded that the "national phase" must be entered before each of the designated Offices indicated in the 
Notification of Receipt of Record Copy (Form PCT/IB/301) by paying national fees and furnishing translations, as prescribed by 
the applicable national laws. 

The time limit for performing these procedural acts is 20 MONTHS from the priority date or, for those designated States 
which the applicant elects in a demand for international preliminary examination or in a later election, 30 MONTHS from the 
priority date, provided that the election Is made before the expiration of 1 9 months from the priority date. Some designated (or 
elected) Offices have fixed time limits which expire even later than 20 or 30 months from the priority date. In other Offices an 
extension of time or grace period. In some cases upon payment of an additional fee, is available. 

In addition to these procedural acts, the applicant may also have to comply with other special requirements applicable in 
certain Offices. It is the applicant's responsibility to ensure that the necessary steps to enter the national phase are taken In a 
- t i m e ly f as hi on . "Most d e s ig n a ted O f f I ce s don ot I ss ue r em i nd e rs to a pp I icants I n co n n e cti o n w It h t he ent ry i nt o t he nation a I ~r 
phase. 

For detailed information about the procedural acts to be performed to enter the national phase before each designated 
Office, the applicable time limits and possible extensions of time or grace periods, and any other requirements, see the relevant 
Chapters of Volume II of the PCT Applicant's Guide, information about the requirements for filing a demand for international 
preliminary examination is set out in Chapter IX of Volume 1 of the PCT Applicant's Guide. 

GR and ES became bound by PCT Chapter 11 on 7 September 1996 and 6 September 1 997, respectively, and may, therefore, 
be elected in a demand or a later election filed on or after 7 September 1996 and 6 September 1997, respectively, regardless of 
the filing date of the international application. (See second paragraph above.) 

Note that only an applicant who is a national or resident of a PCT Contracting State which is bound by Chapter II has 
the right to file a demand for international preliminary examination. 



This notification lists only specific designations made under Rule 4.9(a) In the request. It is important to check that these 
designations are correct. Errors in designations can be corrected where precautionary designations have been made under 
Rule 4.9(b). The applicant Is hereby reminded that any precautionary designations may be confirmed according to Rule 4.9(c) 
before the expiration of 15 months from the priority date. If it is not confirmed, it will automatically be regarded as withdrawn 
by the applicant. There will be no reminder and no invitation. Confirmation of a designation consists of the filing of a notice 
specifying the designated State concerned (with an Indication of the kind of protection or treatment desired) and the payment 
of the designation and confirmation fees. Confirmation must reach the receiving Office within the 1 5-month time limit. 



For applicants who have not yet complied with the requirements regarding priority documents, the following is recalled. 

Where the priority of an earlier national, regional or international application is claimed, the applicant must submit a copy 
of the said earlier application, certified by the authority with which it was filed ("the priority document") to the receiving Office 
(which will transmit it to the International Bureau) or directly to the International Bureau, before the expiration of 1 6 months from 
the priority date, provided that any such priority document may still be submitted to the International Bureau before that date of 
International publication of the international application, in which case that document will be considered to have been received 
by the International Bureau on the last day of the 16-month time limit (Rule 17.1(a)). 

Where the priority document Is issued by the receiving Office, the applicant may, instead of submitting the priority 
document, request the receiving Office to prepare and transmit the priority document to the International Bureau. Such request 
must be made before the expiration of the 16-month time limit and may be subjected by the receiving Office to the payment 
of a fee (Rule 17,1(b)). 

If the priority document concerned is not submitted to the International Bureau or if the request to the receiving Office 
to prepare and transmit the priority document has not been made (and the corresponding fee. If any, paid) within the applicable 
time limit indicated under the preceding paragraphs, any designated State may disregard the priority claim, provided that no 
designated Office may disregard the priority claim concerned before giving the applicant an opportunity to furnish the priority 

lidcu'ment~witlii"n~a~ti~rr^^ '■ — — - — - 

Where several priorities are claimed, the priority date to be considered for the purposes of computing the 1 6-month time 
limit is the filing date of the earliest application whose priority Is claimed. « 
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Tokyo 150-0001 



Date of mailing (day/month/year) 
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Applicant's or agent's file reference 
S00P01 58WO00 


IMPORTANT NOTIFICATION 


International application No. 
PCT/JPOO/00754 


international filing date (day/month/year) 
10 February 2000 (10.02.00) 


International publication date (day/month/year) 
Not yet published 


Priority date (day/month/year) 

10 February 1999 (10.02.99) 


Applicant 

SONY CORPORATION et a! 



1. The applicant is hereby notified of the date of receipt (except where the letters "NR" appear In the right-hand colunnn) by the 
International Bureau of the priority document(s) relating to the earlier application(s) indicated below. Unless otherwise 

• • indicated byan-asterisk appearing next to a date of receipt, or by the letters "NR",:inthe right-hand column, the priority 
document concerned was submitted or transmitted to the International Bureau in compliance with Rule 1 7.1 (a) or (b). 

2. This updates and replaces any previously issued notification concerning submission or transmittal of priority documents. 

3. An asterisk*) appearing next to a date of receipt, in the right-hand column, denotes a priority document submitted 
or transmitted to the International Bureau but not in compliance with Rule 17.1(a) or (b). In such a case, the attention 
of the applicant is directed to Rule 1 7.1 (c) which provides that no designated Office may disregard the priority claim 
concerned before giving the applicant an opportunity, upon entry into the national phase, to furnish the priority document 
within a time limit which is reasonable under the circumstances. 

4. The letters "NR" appearing in the right-hand column denote a priority document which was not received by the International 
Bureau or which the applicant did not request the receiving Office to prepare and transmit to the International Bureau, 

as provided by Rule 17.1(a) or (b), respectively. In such a case, the attention of the applicant is directed to Rule 17.1(c) which 
provides that no designated Office may disregard the priority claim concerned before giving the applicant an opportunity, 
upon entry into the national phase, to furnish the priority document within a time limit which is reasonable under the 
circumstances. 
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A. CLASSIFICATION OF SUBJECT MATTER 
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According to International Patent Classification (IPC) or to both national classification and IPC 
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Minimum documentation searched (classification system followed by classification symbols) 



Int. CI' B25J 5/00 9/12 



Documentation searched other than'minimum documentation to the extent that such documents are included in the fields searched 
Jitsuyo Shinan Koho 1920-1996 Toroku Jitsuyo Shinan Koho 1994-2000 

Kokai Jitsuyo Shinan Koho 1971-2000 



Electronic data base consulted during the intemational search (name of data base and, where practicable, search terms used) 
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Citation of document, with indication, where appropriate, of the relevant passages 
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JP, 10-52089, A (SUZUKI MOTOR CORPORATION), 
20 February, 1998 (20.02.98), 
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JP, 4-53691, A (Matsushita Electric Ind. Co., Ltd.), 
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JP, 3-161290, A (Honda Motor Co., Ltd.), 
11 July, 1991 (11.07.91), 
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2,5,7,10,11,13 



I I Further documents are listed in the continuation of Box C. Q See patent family annex. 
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"A" document defming the general state of the art which ts not 

considered to be of particular relevance 
'E* earlier document but pubtishcd'on or after the intemational filing 
date 

'L" document which may throw doubts on priority claim(s) or which is 
cited to establish the publication date of another citation or other 
s pecial reason (as specified) 

'O" document referring to an oral disclosure, use, exhibition or other 
means 

P" document published prior to the intemational filing date but later 
than the priority date claimed 



later document published after the intemational filing date or 
priority date and not in conflict with the application but cited to 
understand the principle or theory underlying the invention 
"X" document of particular relevance; the claimed invention cannot be 
considered novel or cannot be considered to involve an inventive 
step when the document is taken alone 

document of particular relevance; the claimed invention cannot be 
cons idered to involve an inventive step when the document is 



combined with one or more other suchclocuments, sucK~ 
combination being obvious to a person skilled in the art 
document member of the same patent family 



Date of the actual completion of the intemational search 
09 May, 2000 (09.05.00) 


Date of mailing of the intemational search report 
23 May, 2000 (23.05.00) 
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Explanation of Reference Numerals 



10,.. robot, 11... belly unit, 12... head unit, 13A, 13B...arm units, 
14A, 14B..,leg units, 43... ankle joint mechanism, 44... foot unit, 
70. . .main control unit, 73A through 73D. . .sub-control units, 
106... output axis, 1 1 1 ... control substrate, 112... power substrate, 
148... CPU, M-1 through M-1 4 ... motors , and RTl . . . unleveled ground 
walking controlling procedure. 
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(54) TRANSMISSION SYSTEM FOR CONTROL SIGNAL OF MANIPULATOR^ 

FOR HOT LINE WORK 
(U) 2-59290 (A) (43) 28.2.1990 (19) JP 

(21) Appl. No. 63-210043 (22) 24.8.1988 

(71) FURUKAWA ELECTRIC CO LTD:THE (72) YOSHINORI AONUMA 
(51) Int. CP. B25J19/00,H02Gl/02 

PURPOSE: ^ To safely work with an operator being insulated from a manipulator 
main body by making the control signal received between an operator control 
means and the manipulator main body in the state of an optical signal. 

CONSTITUTION: The system is composed of the optical links 26, 28 converting 
a control signal into electricity-light or light-electricity by being respectively 
provided on an operator control means 22 and a manipulator main body 18 
and optical fibers 30, 32 receiving an optical signal mutually by communicating 
the space between these optical links 26, 28. In the case of the signals to be 
given and received being in the state of an optical signal, the space between 
the operator control means 22 and manipulator main body 18 is completely 
insulated electrically. Accordingly, the operator performing the manual operation 
generating a control signal is insulated from the manipulator main body 18 
and can work safely. 




36.48: parallel/serial. 38.42: serial/parallel 



(54) DETECTING METHOD FOR COLLISION OF ROBOT ARM 
(11) 2-59291 (A) (43) 28.2.1990 (19) JP 

(21) Appl. No. 63-213059 (22) 26.8.1988 

(71) MATSUSHITA ELECTRIC IND CO LTD (72) KEIJI MASUDA(2) 
(51) Int. CP. B25J19/06,B25J18/00 



PURPOSE: To realize the detection of the collision of robot arms of high responsi- 
bility having no need for a sensor by directly detecting the current relating 
to a torque and proportion by the collision detecting part of the inside of a 
numerical value arithmetic processer and detecting the turbulence thereof. 

CONSTITUTION: The waveform of the current flowed in the AC servo motor 
13 which drives a robot arm is read in the collision detecting part 16 of the 
numerical value arithmetic processer 18 inside. The collision detecting part 
16 detects the turbulence of the read current waveform, deciding the presence 
of the collision of the robot arms from the turbulence of the detected current 
waveform and in the case of deciding that the robot arms are collided, 
outputting the stop signal of the robot arm to a main side 4. Due to the collision 
being decided by detecting the current by the collision detection part 16, the 
need for a sensor for detecting collision is eliminated and also the collision 
detection from all directions can be done. Moreover, the torque sensitive to 
impact, i.e., the current is detected and processed softly, so the responsibility 
from detection to the stoppage of the robot arm can be quickened. 
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20: position command, 21: speed command, 22: current 
command. 23: stop signal, 24: current signal, 25: voltage 
signal, 26: position signal, 27: speed signal 



(54) PREVENTING DEVICE FOR FALL OF COMMODITY 
(U) 2-59292 (A) (43) 28.2.1990 (19) JP 

(21) Appl. No. 63-211322 (22) 25.8.1988 

(71) HAJIME ISHIMARU(2) (72) HAJIME ISHIMARU(4) 
(51) Int. CP. B25J21/bO//B01L9/00 

PURPOSE: To surely hold an article with simple operation by moving vertically 
a placing base by placing an article and holding the article with the horizontal 
movement of a holding body, in an article fall preventing device of the case 
of transporting a sample by storing it in a vacuum container. 

CONSTITUTION: In the case of transferring the sample of a semiconductor chip, 
the opening 8 of a vacuum container is connected to a semiconductor manufac- 
_„_turing-device,^the-handIe-24-_of_.a_straight_line_leading_machi^^^^ 

the most significant placing plate 50 is located on the extension of the opening 
8, which is opened by descending a valve plate 36 by a straight line leading 
machine 16, and a sample is placed in order on the placing plate 50"'' by a 
manipulator and the operation of the handle 24 with holding a vacuum state 
by a neg pump 6 and ion pump 7. The sample located on the placing plate 
50 is positioned slightly lower than the corresponding leaf spring 54 of a straight 
line leading machine 16B with the descent of the straight line leading machine 
16 A, a supporting rod 52 is moved to the 49 side, the sample is press- fitted 
to the leaf spring 54 by ascending the placing plate 50 a little and held so 
as not to fall, and in this state the vacuum container 1 is moved to an analysis 
instrument. 
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(54) INK POT 
(11) 3-161288 (A) (43) 11.7.1991 (19) JP 

(21) Appl. No. 64-298869 (22) 17.11.1989 
(71) DAIZEN K.K. (72) MASATOSHI SATO 
(51) Int. C\\ B25H7/04 



PURPOSE: To make ink difficult to dry and to improve the durability thereof 
by providing an ink holding bottom having a cotton filling hole at the upper 
wall with a cotton filled at the internal part on a bottom part. 

CONSTITUTION: When ink is poured into an ink holding bottom 12 from an 
inking projection 18, the ink is first absorbed by the floss silk 14 of the ink 
holding bottom 12 in^ternal part and then sucked up by the floss silk 14 of 
the ink holding bottom 12 upper pari by passing tiirough a cotton liliing hoie 
16 on the capillary principle. The yarn 8 delivered out of yarn wheel is brought 
into contact with the floss silk 14 of the ink holding bottom 12 upper part 
inked and pulled out to the external part from a yarn feeding port 22 




(54) CONTROL METHOD FOR MASTER/SLAVE ROBOT 
(11) 3-161289 (A) (43) 11.7.1991 (19) JP 

(21) AppL No. 64-299404 (22) 16.11.1989 
(71) AGENCY OF IND SCIENCE & TECHNOL(l) 
(51) Int, C\\ B25J3/00 



(72) SUSUMU TATE(l) 



PURPOSE: To improve operability by varying the dynamic characteristic of 
the object held by a slave manipulator with the use of the dynamic characteris- 
tic of the work object found as an impedance and changing the operation feeling 
at the time when a master manipulator is operated. 

CONSTITUTION: The dynamic characteristic of a work object is found as the 
impedance expressed by equations I, II, III(Mo, Bo, Ko show the inertial mass 
of the work object, M,, B„,, show the inersial mass, viscosity and rigidity 
of the tip of a manipulator. shows the position of the terminal of the manipu- 
lator, Xo shows the position of the work object and Xe shows the positions 
of the manipulator and work object, respectively). The dynamic characteristic 
ot the object held by a slave manipulator is then varied with its use, and the 
operation feeling at the time of operating a master manipulator is made heavier 
or lighter apparently. Consequently, a master/slave manipulator of a good 
operability or the stable contact work of a manipulator can be realized 



a. = B. X, /fit 

°' d X. /di -d X. /dt 




a b 



a: object, b: maiiipulator 



(54) CONTROL UNIT FOR JOINT OF LEG WALKING ROBOT 
(11) 3-161290 (A) (43) 11.7.1991 (19) JP 

(21) Appl. No. 64-297199 (22) 15.11.1989 

(71) HONDA MOTOR CO LTD (72) RYUTARO Y0SHIN0(3) 
(51) Int. CP. B25J5/00 

PURPOSE: To relax the impact of a landing time and to stabilize walking itself 
by composing it so as to adjust the gain of a control unit so that the external 
force is reduced with the detection of the external force acting on a foot bottom 

rnxfo4^^ bottom part while profiling to a road. 

LUNbTITUTION: A profiling action is performed by equipping a servo mechanism 

controls^ the joint of a robot 1 with its following up to a target position 

and changing the" operation quantity -in— accordance" with ~tre-ex^^^^^^^ 
acting on the robot 1. In this case, this joint is that which includes the foot 
jomt 18 of a leg walking robot 1 equipped with a foot bottom part 54 at the 
tip, the gain of a control unit 70 is adjusted so that the external force is reduced 
by detecting the external force acting on the foot bottom part 54 with a sensor 
50 and the foot bottom part 54 is landed, while its profiling to a road. 
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74.76; encoder, a: tartfet position. b: external force c 
tanget compliance. d: compliance control unit* e' 

operation quantity, f: joint aoRle control unit, k: walkina 
robot, h: sensor outpuKextemal force), i- toroue i- suewT 
k; position ' 
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